1 


AUTONOMOUS SPACE PROCESSOR FOR ORBITAL DEBRIS 

Final Report 
(1989-1990) 


Submitted by: 

Dr. Kumar Ramohalli 
David Campbell 
Micky Marine 
Mohamad Saad 
Daniel Bertles 
Dave Nichols 


( N A c 
FOR 

( A r i 


A -CP-l 1 ) AUTONOMOUS SPAC * 
, .o t j a l ') fuRiS Pinjl Report, 1 
znni Uni v. ) 1U1 P 


HR n C r SSuR 
9RV - 1990 
C 'cl 7P' 5 


G 1 / i 9 




Unci as 
0~><i 9 l hi 


University of Arizona 
Tucson, Arizona 


Submitted to: 

Universities Space Reseach Association 
Summer Conference 
Cleveland, Ohio 
June 12-15, 1990 



abstract 


This work continues to develop advaced designs toward the ultimate goal of 
GETAWAY special to demonstrate economical removal of orbital debns uti izi g 
resources in orbit. The fundamental technical feasibility was demonstrated in 1988 

through theoretical calculations, quantitative computer animation, a solar focal p 
cutter! a robotic arm design and a subscale model. Last year improvements were 
made ,0 the solar cutter and the robotic arm. Also perfoimed las. yea. ' was a . mission 
analysis which showed the feasibility of retrieve a. leas, four large (>1500 kg) p ece 
of debris. Advances made during this reporting period are the incorporation of dig. al 
control with the existing placement arm. the development of a new robot 
manipulator arm, and the study of debris spin attenuation. These advances are 

discussed here. 

INTRODUCTION 

We can hardly improve upon the lucid descriptions of Ih ' o'bital debris issue, by 
science writersl-4 and other popular news media coverage5-9. Without doubt , .1 
problems of orbital debris have grown to be of serious concern to astronomers, sp 
technologists and to terrestrial dwellers. The specific problems were presented a. the 
XXXIX IAF Congress. The University of Arizona Space Engineering esign 
developing the design for economical removal of the larger debns pieces throug oca 
« utilization! The fundamental idea is to concentrate solar energy into a pom 
focus, cut die debris into precise shapes that can be added on to the SW “P« c 
and robotically assemble the pieces into a manageable C0 "' i8 “ r “"° n E ° E j „ URAN 
by one of three disposal modes: (i) retrieval by a spacecraft (STS, HERMES ’ 

etc ) (ii) precise ocean splashdown, or (iii) planned bumup upon atmospheric ree y. 
Th! fundamental space technologies to be demonstrated are solar cutting of candidate 
space debris materials, robotic assembly and accurate disposal. In 1988 he 
University of Arizona began participation in the USRA program and demonstrated 
solar cutting and a subscale model robotic arm. In 1989, a full scale robotic arm with 
manual controls was developed and the solar cu.ter/robotic arm assembly was shown 
to be technically feasible. Also in 1989, a mission analysis was performed in which 
the large debris environment was identified and a four debns retrieval saniple 
mission analysis showed the propellant requirements to be well within reasom ■ 
year 1990, the existing robotic arm was converted to digital control using a • 

a second robotic arm was developed for precise pick and place operations and the 
problem of debris tumbling was addressed and various de.umbl.ng methods were 
investigated. This report is a summary of the work and explains the details of space 

engineering. 

Consistent with the USRA philosophy, new undergraduate students were involved in 
the design process. This year, 11 new students were involved in the Autonomous 
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Space Processor for Orbital Debris (ASPOD) design. The project continues to draw 
worldwide attention including correspondence with elementary and high schools. 
Some of these are documented in the Appendix. 

The support from USRA and the technical monitoring of Mr. James D. Burke of JPL are 
gratefully acknowledged. Mr. Milton Schick contributed greatly towards the 
development of ASPOD. 
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DEBRIS SPIN ATTENUATION 


The purpose of this project was to research and recommend methods of attenuating the 
rotational spin of orbital debris so that ASPOD satellite can safely grasp them for retrieval. 
To avoid possible damage to the ASPOD craft, only passive means of attenuation were 
investigated. The use of passive means is defined as the use of methods of attenuation which 
do not involve ASPOD in direct contact with space debris therefore endangering it. Some of 
the design criteria and target specifications are outlined below: 

-Attenuate the rotation of an object spinning about one axis. 

(see Appendix A for details of satellite spin stability.) 

-Attenuate the rotation of an object having a mass of up to 2000 kilograms 
and rotating with rotational speeds of up to 50 revolutions per minute 
-Attenuate the rotation of an object up to 7 meters in diameter and up to 7 
meters in height 

-Use a minimal amount of energy 
-Attenuate at least 4 objects per mission 
-Require no maintenance 

-Must not interfere with the normal operation of other functional satellites 

-Must not create more debris 

-Must weigh less than about 500 pounds 

-Must have a reasonable expense relative to the space industry 

Satellites and most other space debris generally contain a certain amount of rotational energy. 
The problem of dealing with the rotation of a large, nonsymmetric object containing a lot of 
mass orbiting the earth must be solved before the satellites can be safely and effectively 
collected. 

A workable solution dealing with debris capture must allow the rotational energy of the debris 
to be contained or dissipated without transferring it to the collector satellite. The space debris 
that is proposed for collection is often very massive, 2000 kilograms or more, with spin rates 
of up to 50 r.p.m.. These figures suggest that there can be quite a bit of angular momentum 
involved. 


SOLUTIONS 

As a first step, various attenuation methods were researched and evaluated. Of all the 
methods investigated four were chosen as possible solutions and merited further analysis. 
Each of these four solutions uses a different physical principle, for example, conservation of 
angular momentum or conservation of energy, to accomplish the attenuation of the satellite. 
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Although each of the four designs merit further investigation, for the present the most 

promising of the four was singled out for detailed analysis and testing. 

A) Reeled Weight Mechanism 

The physical principle used in this method is to translate the rotational energy into 
linear kinetic energy, then into potential energy. This design uses a reeled cable capable 
of attaching itself to the debris by the cable's free end. Also contained in the reel 
mechanism is a generator allowing the cable to reel out, turning permanent magnets 
around a stationary armature and storing that energy in a battery. This generator can 
then act as a motor by turning the stored energy in shaft power, allowing the cable to be 
reeled in. Once the free end of the cable is attached to the debris in its plane of 
rotation, the reel is then allowed to freely move away from the debris due to centrifugal 
acceleration, yet is still tethered by the cable. The reel will move away in a straight 
path while the debris continues to spin and the attachment point of the cable on the 
debris will rotate with the debris, wrapping a portion of the cable around the debris. 
At this time the reel will create a drag force on the cable by engaging the generator and 
then storing that energy. Due to the centripetal force of the reel attached to the much 
more massive piece of debris, the reel will attempt to move into a radial position about 
the debris' center of mass. Before it comes near this point some of the stored energy 
will be used to reel the reel mechanism back into the debris, at which point the process 
will start over. Some of the advantages to this system are the ease of attachment to 
essentially any shape of debris, and the relative simplicity of the mechanism. Some of 
the problems are the difficulty in analysis and testing of the system and the chance of 
the cable becoming permanently entangled in protrusions on the debris. 

B) Coiled Spring Mechanism 

Figure 1 presents the proposed configuration for the coiled spring mechanism. This 
proposed mechanism consists of a component for attaching to the debris, a ratchet, a 
coiled spring and a stabilizer. The idea behind this solution, is to absorb the rotational 
energy of the debris and store it in a coiled spring as potential energy. The purpose of 
the ratchet is to act as a locking mechanism for the spring when it winds up completely. 
Winding up the spring though, necessitates the use of a stabilizer to hold the other end 
of the spring fixed. A stabilizer is thought of as a servo-controlled gyroscopic platform 
where gyroscopes are to be used only as sensors. The resolver (the "brain" of the 
control system) will be continually feeding corrections through the feedback controlled- 
loop to keep the attachment to the platform fixed in space. The greatest advantage of 
this process is that it can attenuate the rotation of the debris quickly, within minutes (see 
Appendix B). Furthermore, the attenuation of the debris is complete (100%). The 
disadvantages of this idea are the requirements for powering the gyroscopic sensors and 
lubricating the ratchet. Another more important problem is that the ASPOD will 
eventually be involved actively in the process by powering several thrusters as well as 
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its momentum-wheels, since this may create safely problems for the vehicle itself, the 
idea was abandoned for the time being and our effort was concentrated on developing 
passive means of attenuation. 

Coiled 

Spring 



Attachment Locking 

Mechanism 

Ratchet 


Figure 1. Coiled Spring Mechanism 
C) Long Cable Mechanism 

For this design there are two ways in which it could work. One would be to let out a 
cable with a mass attached to the end, thereby increasing the moment of inertia, and 
slowing the satellite down. This would not allow the satellite to some to a complete stop 
but it could possibly slow the satellite down enough for a robotic arm to manipulate it. 
The cable would have to be cut off when maximum attenuation occurs, preferably so 
that it would reenter the earth's atmosphere, because once the robotic arm attached to 
the satellite the cable would reel in uncontrollably due to the momentum of the cable. 
The other method would be to leave the cable on for an extended amount of time and 
allow the gravity gradient to slow the satellite to a complete stop. The satellite could 
then be grabbed and the cable reeled in since the rotation of the satellite would be fully 
attenuated. Figure 2 shows a representation of this method. 
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D) Geared-Bar Mechanism 


The geared-bar mechanism is the solution recommended selected by the attenuation 
research group for further development and is detailed below. 


GEARED-BAR MECHANISM 
A) Theory of Operation 

A representation of the gear bar can be seen in Figure 3. The centrifugal acceleration 
acting on the flywheel, forces the flywheel radially outward to the end of the geared- 
bar. If the geared-bar was smooth, the flywheel would just translate outward without 
spinning, however, the contact forces between the gear and the bar apply a torque about 
the center of the gear forcing the flywheel to spin as well as translate. Mathematical 
analysis (see Appendix D) and experimentation shows that as the angular rotation of the 
flywheel increases, the angular rotation of the debris decreases. A ratcheting 
mechanism is attached to the system so that when the flywheel reaches the end of the bar 
the flywheel will continue to rotate freely. 



The effectiveness of our design depends on the length of the geared-bar and the mass 
moment of inertia of the flywheel. It could happen that the configuration necessary to 
achieve an adequate amount of attenuation would be unfeasible to take into space due to 
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the size and/or mass of the flywheel and the length of the bar. If this is shown to be 
true it chould be possible to attach a motor to the flywheel and “reel” the flywheel back 
in, while the ratchet mechanism allows it to maintain its angular velocity, and let it 
move out again. This process could be repeated as many times as necessary. 

B) Design 

A rudimentary device was fabricated for experimental purposes. The design that was 
used included a rubber wheel and friction bar to simulate the rack and pinion system. 
A small cart supporting the flywheel and friction wheel with a bearing rolled along a 
track that represented the geared-bar. The friction wheel rolled along a friction bar 
attached to the track forcing the flywheel to rotate. The combination of the flywheel 
and the cart simulated both the rotation and the translation of the flywheel. To 
simulate the ratcheting mechanism, the friction bar was cut shorter than the track. This 
allowed the flywheel to rotate freely once it reached the end of the track. This design 
was not adaptable to the use of a motor; however, it was felt that showing that the 
theory mechanism would work for one pass was sufficient to show that this method of 
attenuation was feasible. 

C) Experiment 

Previously, a large model representing space debris was built for attenuation 
experimentation purposes. This model is an octagonal solid approximately 48 inches in 
diameter and 72 inches high with a calculated mass moment of inertia of 655 lbm ft. 
The "debris" is attached to the ceiling and floor with a large metal rod that it rotates 
about. Lubricated bearings were used to minimize the frictional effects. 

To gather data, a systematic process had to be developed to measure the time per 
revolution. A computer program was used to record the needed data. A mark was 
made on the "debris" and then the debris was spun up to an appropriate speed. Each 
time the mark came into sight, a key was pressed on the computer. The program would 
then print the number of the revolutions and measure the time elapsed. With this data, 
the program calculated the time between revolutions and revolutions per minute for 
each revolution. Finally, this data was exported to a spreadsheet program for further 
analysis and graphing. 

To prove the effectiveness of the geared-bar mechanism, it was necessary to find a way 
to separate the effects of the changing mass moment of inertia, due to the flywheel 
translating outward versus the effects of the rotational kinetic energy being transfered 
to the flywheel. To do this, reference data had to be taken. This reference data 
consisted of several measurements with the flywheel retracted, and several with the 
flywheel extended. Before measurements could be taken with the geared-bar 
mechanism fully operational, one additional component needed to be added. Because 
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the debris needed to be brought up to a functioning speed before the flywheel could be 
released, it was necessary to develop a release mechanism so that the flywheel would not 
begin to move before the appropriate speed was attained. This was done by including 
an eyelet on the flywheel, and passing a pin through it that could be easily pulled out 
when needed without significantly effecting the speed of the debris. 

As stated above, these measurements were taken for each case, the flywheel retracted, 
extended, and operational. Figures 4, 5, and 6 show the relative quality of the 
measurements for each case and their characteristic curves. 



Number of Revolutions 


Figure 4. Flywheel Retracted 



Number of Revolutions 


Figure 5. Flywheel Extended 
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Figure 6. Flywheel Translating 


Although the reference data was taken, a standard procedure to spin up the debris at an 
equal RPM for each run was not developed, nor was there a way to measure the energy 
added to the system. It was, therefore, necessary to determine a method for comparing 
the data with the three different cases. Because of limitations with the graphing 
software used, it was felt that taking the points at which the debris came to rest with 
each case and counting the maximum, common number of data points backward would 
be a reasonable method for developing a common reference. For example, the working 
case only included 14 data points, so the last 14 data points for each case were used. 

Figure 7 illustrates the effects between the three different cases. The line with the 
flywheel retracted is steep due to the low relative inertia. The line with the flywheel 
extended is flatter and the time of rotation longer due to the effects of increased mass 
moment of inertia. If the working case decreased the rotational speed of the debris 
solely due to the effects of the changing mass moment of inertia, one would expect the 
line for the working case to lie somewhere between the retracted and extended cases. In 
fact, the graph should begin at the approximate point of the retracted case because of 
the identical value for the mass moment of inertia and end near the same point of the 
extended case because the same amount of energy should still be in the system. It was 
not the groups goal to "prove” the effects of changing the mass moment of inertia, but 
to prove that the flywheel actually absorbs the energy of the debris. To confirm this, 
the graph of the working case should start near the point of the retracted case and end 
significantly below the extended case. The working case line does follow this 
hypothesis. 
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ORIGINAL PAGE IS 
OF POOR QUALITY 


Figure 7. Experimental Comparison 

This experiment does not exactly model the case of debris spinning in space because 
satellites in space are not pinned, therefore the center of rotation would change as the 
flywheel moves out. The mass of the flywheel could be optimized to minimize these 
effects. Nonetheless, this system of attenuation will still work, because the center of 
rotation will always lie between the centers of the debris and the flywheel, maintaining 
the centrifugal component of acceleration moving the flywheel outward. 

In conclusion, and most importantly, the geared-bar mechanism of the experimental 
case does absorb the rotational energy of a spinning body. For the three cased 
mentioned above, the time for the last 14 data points is 253 second for the retracted 
case, 400 seconds for the extended case, and 59 seconds for the working case. The 
above experiment also proves that the attenuation is not solely due to the change in mass 
moment of inertia but actually performs a significant amount of energy transfer. 


D) Computer Modeling 

In order to investigate the dynamics of the geared-bar mechanism, as an attenuator of 
the rotational energy of a satellite, several approximations to the actual case were 
considered. The first case, consisting of the two-dimensional analogue (Figure 8) of the 
actual case (Figure 9), assuming perfect targeting and neglecting the attachment phase 
and the endpoint locking of the flywheel, was solved analytically and appears in 
appendix D. 


Figure 8. Attachment Parameters 



Figure 9. Attachment Sensitivities 


Under the above assumptions, the analysis suggested that an attenuation of about 50% 
could be attained for a rack length of 4 meters, and an operation of 50 seconds. These 
results pertain to a satellite modelled as a 2000 kg cylinder, 4 meters in height and 3 
meters in radius rotating at 50 rpm. The 40 kg flywheel used in the analysis was 1 
meter in diameter, while the rack was assumed weightless. At this point it should be 
mentioned that the attenuation effects are highly dependent on the inertial properties of 



the satellite. Thus, it should be kept in mind that the diversity of satellites to be 
attenuated adds to the complications and limits the applicability of the design. 

In order to investigate the effects of the geared-bar attenuator when it is not attached at 
right angles to the principal axis of rotation of the debris, as well as when it is attached 
off center with respect to the satellite' s center of mass (Figure 9), an analysis was 
attempted on a software package available at the University of Arizona. A copy of the 
parameters for the program can be found in Appendix E. This software facilitated a 
three dimensional analysis and made it possible to animate the resulting effects, for 
visual and demonstrational purposes. For a satellite with inertial properties as 
mentioned above, the software shows attenuation as high as 70% during the first 5 
seconds for the two dimensional case, but not more than 25% for the three dimensional 
case that involves geometrical asymmetries and precessions. The fact that the rack and 
pinion joint is not 100%, as was assumed by the software, will lengthen the time needed 
for attenuation. Figures 10 and 1 1 show the angular velocity of the debris for the two 
and three dimensional cases respectively. 



Domain 
0 to 5 sac 


Range 

0 to 50 rpm 



Qomain 
0 to 5 sac 


Range 
0 to 50 rpm 


Figure 11. 3-D Computer Modeling 










The results indicate that the targeting and alignment of our device is essential and 
therefore a process of determining the center of mass of the debris before operation is 
essential. The software can provide results once the device is attached on the satellite; 
however, impact forces caused by the attachment process were not modeled. 

To evaluate the model, a final comment on the effects upon impact needs to be made. 
Provided that no eccentric forces are present, i.e. perfect targeting, any components 
directed radially from the earth will cause oscillations that are estimated to die out. 
Moreover, any angular components will result in shifting the orbit but not changing the 
orbit altitude. Thus, the effects on the debris will be mostly translational and will not 
greatly affect the attenuation process. 


E) Attachment 

Since the purpose of this project was to test processes for attenuation the issue of 
attaching the mechanism to the satellite was not initially addressed. However, it was felt 
that developing a method of attachment was necessary to complete the subject of 
attenuating the rotational motion of orbital debris. 

Several ideas were considered. Wrapping something around the satellite (similar to 
lassoing) was discarded because it could not be guaranteed that there would be a 
perfectly clear path all the way around every satellite due to auxiliary objects such as 
antennas. Grabbing the satellite was not felt to be practical because the skin of the 
satellite is very flimsy (since its only purpose is to shield the inside from solar radiation 
and small particles) and could not sustain very large forces and moments. 

The conceptual design of the device that was chose to build was much like an umbrella. 
The device would pierce through the skin of the satellite and once inside open up, much 
like an umbrella, to prevent the device from slipping back out. 

As can be seen in Figure 13, a motor turns a threaded rod and the collar with the 
shorter links attached begins to move. Once the collar contacts the back-plate the collar 
no longer moves along the threaded rod and the shorter links then pull the larger links 
until both are at right angles to the threaded rod. The mechanism would have worked 
with only the longer rods; however, the design chosen minimizes the load that each link 
has to take and increases the mechanical advantage of each link, thereby requiring less 
energy. 



6 in link 


12 in link 


60-degree-ongle arm 



Figure 12. Attachment Device 


The motor to drive the threaded screw would be a D.C. motor. The batteries would be 
charged prior to usage utilizing the power source available to ASPOD. 

F) Conclusion 

The overall purpose of our part of the project was to research and design a mechanism that 
would slow or attenuate the rotation of a satellite. The solution found would involve 
launching a geared-bar mechanism to the piece of debris. The tip would pierce the skin and 
six links would then open up to keep the device in place. The flywheel would then be 
disconnected from its locked position and allowed to rotate out. This would transfer the 
rotational energy from the satellite to a more manageable form in the flywheel. This method 
was proven to work through experimentation and mathematical and computer analysis. 


DIGITAL CONTROL OF PLACEMENT ARM 

The ASPOD design incorporates a solar-powered metal cutter to facilitate dead satellite 
processing in a cost effective manner. In order to position debris at the focal point it is 
necessary that the ASPOD be equipped with robotic arms. The arm function is to hold and 
move material to be cut in the focal plane of the solar concentrator. After this initial 
developments stage the gathering arm was controlled with a variable speed on/off control 
panel. In order to automate the arm and to better simulate its operation in space, a 
hardware/software controller was designed. The objective of the digital control was to 
eliminate the direct human interface initially needed to operate the arm and to replace it with 
a software interface that would accept commands entered into a PC terminal. The digital 
control would increase the accuracy of the arms' movements and with the software interface, 
a program could be developed in order to perform a pick-and-place operation or a more 
defined cutting operation. 



Design Specifications 


The robotic arm has five revolute joints as shown in Figure 1 with axes and degrees of joint 
rotation. The most important component of the whole robot system is the digital control 
system whose components are: a power supply, voltage regulator, two motion controller 
boardsf from Motion Engineering), five motor drivers, five optical encoders, five dc motors, 
and an IBM PC. Two of the hardware parts - the power supply and the motor driver - 
required custom design and fabrication. These components were constructed by members of 
the team. 


Swing of qandad arm (1 degree of freedom) 



Figure 1* Robotic aim showing degree# of freedom at joinu 

The hardware needed to build the power supply included a transformer, a bridge and two 
capacitors to produce a dual output of +25V/-25V with a smooth signal (resembling dc 
voltage). The +25 V was also connected to a voltage regulator to produce +5 V for the 
optical encoder. Figure 2 shows the circuit design for both the power supply and the voltage 
regulator. 

Five individual motor drivers (channels) were built within the motor driver. Each driver 
consisted of a high voltage operational amplifier to amplify the input voltage from motion 
controller boards, transistors, capacitors and resistors (see Figure 3). The motor driver 
receives a voltage from the motion controller board between -10V/+10V. The operational 
amplifier amplifies the voltage at values of +20 to -20V. The transistor amplifies the current 
and then sends a voltage to drive the DC motors at each joint of the arm. 



♦25 V 
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Hgure 3. Circuit design of motor driver 


The optical encoders (HEDS-5600) are used to provide accurate motion detection. It provides 
high performance, optical incremental encoder which emphasize high reliability and 
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resolution, low cost and easy to assemble. The optical encoders were attached at the points of 
rotation to measure the angle of rotation at each joint. The optical encoders required a rigid 
mount and modification to the shaft at each joint. Their operational description is located in 
the Hewlett-Packard specification sheets in appendix. F. 

Two motion controller (MC) boards control the five DC motors on the arm. The MC-400 is 
able to control four motors while MC-200 can control two motors. The two MC boards are 
connected to the computer and wired to the motor drivers. Included in the package with the 
controller boards were two types of software: the “Stand Alone Program” aids in the 
installation and testing of the optical encoders and the MC boards; the “Utility Subroutine and 
Program” aid in the development of a customer- written program. The software can be 
written in either "C" or "BASIC". The MC controller boards were accompanied by a user 
guide to assist in installation and operation. The block diagram for the control system is 
shown on the next page in Figure 4. 



Figure 4. General block diagram for Robotic Ann Control System 


The decision was made to use these MC boards over other possible choices because the 
controller cards were designed around the HCTL-1000 general purpose Motion Control IC. 
The HCTL-1000 has the capacity to handle all encoder input decoding, phase commutation for 
steppers and brushless servo motors, digital filtering of the control signal, and generation of 
analog or pulse-width-modulated motor command signals. It continually performs intensive 
tasks of digital motion control, therefore freeing the PC for other planning tasks. The HCTL- 
1000 operation is controlled by a bank of 64 internal registers which in turn, can be accessed 




by mapping within the PC memory. There is no need for interrupt handling during 
operation. Refer to appendix. G for design characteristics of the HCTL-1000 

To develop the control system, the robotic arm is viewed as a continuous time-varying 
system. The Laplace transform technique is utilized to simplify the analysis. The block 
diagram in Figure 5 depicts the feedback closed loop system of the robotic arm control. The 
digital controller is IBM computer, while the DAC is a digital-to-analog converter, and the 
ADC is an analog-to-digital converter. The amplifier is the motor driver circuit used to 
convert the low level analog torque signal u(t) to a voltage v(t) , which directly activates the 
joint motors. Since the joints are dc motors, the generated torque is proportional to the 
armature current. Therefore, the amplifier in Figure 5 is an analog subsystem regulating the 
current through variations in the applied armature voltage. The ADC block detects the 
position(encoders) and the speed(tachometers) of the joint motors and converts them into a 
form recognized by the digital controller. Thus, the sensors here represent an encoded disk 
(optical encoder) of the type analog-to-digital converter. 



Optical Encoder 


Rgure 3. Feedback cloud loop tyrtem of digital control 


The status of the project at this point is that we have control of four of the five motors on the 
arm. A program was written in "C" which can demonstrate a predetermined movement of the 
arm and its return. Since the initial (zero) position sensors are not installed, the arm can only 
be controlled using the joint coordinates. Two sample programs were developed for this 
purpose. One uses the voltage to control the joints. It reads and records the guadrature 




counts from the optical encoders. The second program uses the trapezoidal profile position 
control in an interactive mode. It has been modified to execute a sequence of point - to - point 
positions in the specified envelope. A copy of both programs is in appendix H. The user at 
this point may move all joints simultaneously or move one joint at a time to a predefined 
position. This requires only one keystroke to the keyboard. 


Future plan 

The future plan of the software project is to move the arm with all five degrees of freedom 
integrating in a "pick-and-place" fashion. The arm will also be able to be moved to any 
predetermined position in the physical envelope of the apparatus ( i.e move anywhere defined 
in polar(r,q) coordinates). Future work involves some hardware and software amplifications. 
For the hardware, some position sensors need to be installed for the initial (zero) position and 
instal an optical encoder at the wrist. For the software aspect. The relationship between the 
inverse kinematics of the robot arm and the trajectory planning needs studied in more depth. 
Integration of the second arm must also be achieved. Components of this integration include 
state-of-the-art Artificial Intelligence and decentralized control algorithms. Additional 
considerations for the software portion include both error checking and recovery Software 
which must be designed with the focal cutting point in mind as well as an initial (zero) 
position. All of the above points must be intrinsic to the computer software each time the 
machine is booted up or loaded. The future work of the project will take place in the 
succeeding semesters by other design teams. 


MANIPULATOR ARM 

The ASPOD spacecraft will need two robotic arms to succesfully retrieve and process a 
piece of orbital debris. This year the task was taken to design and fabricate a new 
robotic arm. This arm was to be designed with the specific ASPOD mission in mind, 
and have the flexibility necessary for the handling of large pieces of debris. 

LIMITATIONS 

There will be no subsequent contact with the orbiter once it has been launched, 
therefore it must be reliable. The arm must have a hand capable of grabbing most 
space debris as well as grappling with a larger satellite. Control of the arm must be 
precise. Vibrations must be minimized as well as slop/backlash within the arm's 
actuator mechanisms. The design must be adaptable to digital control and the 
electrical system must run off a 24 volt power supply. 


DESIGN (TARGET) SPECIFICATIONS 


In the process of generating alternative solutions the solar mirror structure was 
analyzed to determine the necessary DOF's. By approaching the problem in this 
manner, we would not have to analyze and build models to treat every design that 
didn't have any immediate foreseeable problems. The analysis by this method led to a 
very unique solution. 

To start, it was determined that the easiest way to remove the lens from the holding 
slot was to translate it along an axis contained within the plane of the lens., (see fig. 1 ). 
We can call this the hand axis from here on to clarify our discussion. Note that we 
assume the grasping mechanism to be attached to this axis. 



Figure 1. Hand Axis 

To reach all three lenses with the hand axis in this orientation with respect to each 
lens individually, it is necessary to rotate about the central axis of the mirror 
structure, (see fig. 2). 



Figure 2. Central Axis Rotation 
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The next requirement is for the arm to be able to reach the focal point. From figure 3 
it can be seen that we need only to translate along an axis parallel to that of the 
central axis to meet this requirement. Finally, to reach debris located above the mirror 
structure the mechanism must be able to rotate about an axis perpendicular to the 
plane created by both the hand and central axis . 



Figure 3. Focal Point Within Reach 

With these three DOF's we have a work area with roughly the shape of a cylinder with 
half spheres at the ends. Adding more DOF’s in the form of joints or extensions would 
be redundant at this point. The adding of redundancies may decrease the difficulty of 
specific tasks. For example, in the case where an obstruction prevents the arm from 
directly reaching an object, it may be necessary to have another joint in the arm to 
essentially reach around the obstruction. 

It is important to note that none of the DOF’s required by the hand to perform 
properly have been considered here. The reason is that the DOFs discussed so far are 
for location and orientation of the hands, i.e.- getting the hand to the desired locations 
; whereas, the DOF's required by the hand are for orientation of the hand to receive 
the object. Those DOF's will be discussed in the subproblems involving the hand. 

Using the three fundamental DOF’s, the configuration in figure 4 was proposed. Also, 
the design in figure 8 shows the arm with several redundancies. Note that the ring 
was used to accomplish the rotation about the central axis so that no part of the arm 
would be prone to moving through the focal point (see fig. 4&5). 
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Figure 4. Final Design 



FINAL DESIGN Figure 5. Final Design 

Polar Drive Mechanism 

The purpose of the axial tracks is to translate the entire robotic arm structure along 
the body of the collector (see appendix 1.1). This is accomplished through the motor 
driven screws shown in fig. 1.2. The motors have an output of 100 oz-in. at 30 rpm per 
motor. This velocity will cause the polar track assembly to move at a rate of 4 in./min. 
The reason for keeping the velocity low is to prevent unwanted oscillations in the 
system. The power screws are regular 0.5 inch and 13 threads per inch. 



The main load of the polar tracks is taken up by the bearings inside the pillow blocks 
(see fig. 1.3). The bearings are 0.75 inch linear bearings. Two linear bearings were 
used to prevent horizontal motion. The bearings ride on 60 case hardened steel rods. 
This material was chosen because of its great stiffness capabilities and availability. 
Along side the bearings, inside the pillow blocks, there are two couplings. The reason 
for using two is also to prevent horizontal deflection and to maximize the contact area 
between the pillow blocks and the driver screws. 

The connection between the pillow blocks and the polar track is done through the flat 
plates that are welded to the polar track and the pillow blocks. The flat plates are 
bolted together. 

The tracks are supported at the ends (see fig. 1.4). They were manufactured out of 
aluminum stock. 


The circular track allows the arm to rotate about the focal point allowing the arm to 
align itself in a normal sense to the lens axis. The circular track allows the arm to 
access the mirror/lens structure without interference. A wide-base channel section (5 
X 1.75 inch cross section) provides the necessary contact points to mount the arm and 
yields a "chamber" of space essential to the drive mechanism (see appendix J.l). The 
channel material is 5052 aluminum and initially weighed 24 lbs. The weight was 
reduced to approximately 19 lbs. by drilling thirty 2.5 inch diameter holes along the 
web and are evenly spaced 3.5 inches apart center to center. The holes did not weaken 
the track but did slightly deform it. The track's inside diameter was reduced by 
approximately 0.5 inches and is not a problem. 

The arm is mounted onto the arm-platform (see fig. J.2) which contacts the channel 
track at six points; four on the outside and two on the inside. The rollers are Killian 
bearings which provide normal and lateral stability. The four outside bearings have 
been modified to prevent derailing. A washer has been pressed against the lip of the 
bearing. Two pairs of springs are incorporated in the design of the platform. One pair 
clamps the inside rollers to the platform providing normal stability, and the other pair 
ensures lateral contact of the bearings to the track. The springs are necessary to 
account for track irregularities. 

The drive mechanism is shown in appendix J.3. It is simply a dual chain/sprocket 
drive. Power is transferred through a 50:1 worm gear reducer. The motor ordered was 
found to be faulty. It was rated at 10,000 rpm, 9 oz-in. torque. It was to operate at 
shaft conditions of 500 rpm, 180 oz-in. This would give more than the needed torque 
of 500 oz-in. Testing showed motor output was nowhere near these specs, so it was 
necessary to use a motor that was found and worked. No characteristics are known 
about the motor. Testing of the circular track drive mechanism showed that operation 
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performance was adequate for loads of 15 to 20 lbs. Figure () shows theoretical 
curves for required motor power consumption . Theta refers to the angular position of 
the drive mechanism. 

Elbow Joint 

The elbow joint provides one degree of freedom which enables objects to be moved in 
or out of the focal point. It also supports access radially outward from the polar track 
providing access to objects which lie outside the ASPOD's framework. The elbow 
consists of two major components (Fig. Kl). 

The first piece holds the motor, worm and braces the 5/16" shaft with a 7/8" OD roller 
bearing press fit at either side. The selected motor is shown below as motor #1. The 
worm is steel, single tooth and 32 pitch. The shaft is held in place with snap ring. 

The second major part of the elbow joint has a 32 pitch 100 tooth worm wheel pressed 
into it. The worm wheel mates the worm on the first part when placed on the shaft. 
The shaft has a flat milled across it and is fixed to the worm wheel with a 5-40 set 
screw. The set screw is 2" long so it not only holds the shaft but also fixes the wheel to 
the second piece. 

Both parts of the elbow have a 1" long hollow male fitting which is placed into a 1.5" 
OD .0649" thick pipe. All structural parts are made of aluminum, all fasteners are steel. 


Motor Rotor Assembly: 

The motor rotor assembly is a gearbox which holds the arm above the polar track and 
allows the arm to rotate a full 360^ (Fig. L2). This provides access to objects in front, 
behind or to either side of the ASPOD. The gearbox consists of two 9" x 4" plates 
separated 2.5" by four spacers (Fig. L3). The motor drives a 24 pitch 100 tooth worm 
wheel which is held on the end of a shaft end of the shaft/endcap with 5-40 set screw. 
The motor selected for the gearbox is identified as motor #1. The motor is held at the 
precise height and angle with the motor mount (Fig. L4). 

The shaft/endcap is machined to have a 3/8” shaft on one end and a 1/2" long hollow 
male fitting on the other. It protrudes through the top of the gearbox so that the 1.5" 

pipe which holds the elbow joint can be attached (Fig. L2). The pan of the endcap 

which joins the shaft was threaded with 9/32" -18 threads/in. The shaft fits through a 

bearing and is held by a 9/32" nut. The bearing is held in place with a machined cap. 

The cap was machined to have a snug fit with the bearing circumference and have a 
1/1000" interference fit between the bearing and top plate. The cap is fastened to the 
plate with four 6/32” bolts. 
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Motor Selection: 


The following motors were selected on their torque and speed. The exact weight was 
unknown but a rough estimate considering their size was also considered. The motors 
needed to have this great amount of torque as our initial estimates of the arm weight 
were too low. These motors will allow the arm to retain its original design capabilities 
of lifting a 2 lb plate at an extension of 33 in. 


Motor# Quantity Torque (oz-in) Speed (RPM) 


1 2 100 

2 1 25 

3 3 100 

4 2 75 


375 

1000 

75 

30 


Grasping Mechanism 

The requirements of the grasping mechanism are to be able to grab a thin flat plate 
ranging in thickness from 0.125 to 0.75 inches, to grasp a cylinder with a diameter 
ranging from 0.125 to 4.000 inches, and to grasp a sphere with a diameter equal to 
that of the cylinder. Other general requirements for the mechanism are that the 
weight be minimal, the ratio of the clamping to the actuator force be maximized, and 
that the force ratio be as nearly constant throughout the range of motion of the 
mechanism as is possible. 

For the design that was developed and built to meet the requirements the ratio of the 
clamping force to the actuator force is 0.25 and is nearly constant throughout the 
clamping range. The ratio was determined by constructing a static force vector 
diagram on each design at intervals in their range of motion. There was a trade off 
between the increased ratio and smaller size. In appendix M, figures 1-3 show the 
selected design in its fully extended, closed and intermediate positions. From figure 
four of appendix M it can be seen that the force ratio would increase if the distance 

between the two sets of four bar linkages was increased. This design was chosen over 

five others because of its higher clamping force ratio, its smaller size, and its 
simplicity. 

Figure five and six of appendix M show the dimensions for both the base and grip 

respectively. The holes shown in those two drawings have a 0.251 inch diameter to 

allow for a slip fit around a 0.250 ground pin. Figure seven shows the dimensions for 
the two different links and push- rod. Table one on page eight of appendix M shows 
the parts list for the prototype . 
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The robotic arm must have translation along the axis of the arm and rotation about the 
circular track to provide access to the focal point of the orbiter. 

Harmonic Vibrations 

Vibrations of any space structure creates special problems. The payload must be 
deployed, be able to precisely grab objects and not suffer damage trying to capture 
satellites due to fatigue. 

The space shuttle has a natural harmonic frequency of 32 Hz which prevents it from 
carrying a payload with a corresponding harmonic frequency less than or equal to 32 
Hz. Such a payload (> 32 Hz) would certainly cause resonant vibrations of increasing 
amplitude. Damage to the shuttle resulting from resonance would be likely since it 
takes several hours to deploy any payload and the shuttle would be subject to the 
resonant vibrations until deployment since there is no damping in space. 

If the robotic arm is to grasp an object, the exact position of the manipulator must be 
known. Low frequency vibrations tend to have greater amplitude and the end of the 
arm could move more than an inch. Use of space-rated composite materials (higher 
structural stiffness) would help to alleviate this problem. 

If the amplitude of harmonic vibrations is too high, the robotic arm will experience 
high stresses. These stresses will cause fatigue damage if aluminum is the primary 
construction material the arm. This is especially dangerous since space structures 
usually have little or no factor of safety. Composites have better fatiguing properties 
and should be used in all high stress areas. 


Conclusion 

This years research team designed and constructed the primary grappling arm. The 

arm has the ability to maneuver large and bulky objects into the focus of the frenel 
lense solar cutting device without obstructing the beam. A secondary function of the 
arm is to be able to repair or replace any of the frenel lenses if they are damaged. 
Both of these goals are met with the ASPOD robotic arm. 

Most of the design specifications have been met. The arm can grasp a variety of 

objects from round balls to flat plates. It can be adapted to computer control by future 
design teams. All motors operate at 24 Volts (some are rated slightly higher but this 

presents no problem). The arm appears able to replace frenel lenses and repair the 

mirror array. However, the arm is not light weight in fact it is so overweight that the 
Polar Arc is in distress. The arm isn't reliable enough to operate for months of years 
without service. 
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Replacement of some aluminum parts with graphite composites would greatly increase 
the performance of the robotic arm. Not only will weight be drastically reduced but 
problems due to the low harmonics (4 to 10 Hz depending on its position) of the arm 
will be improved. 
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APPENDIX C 


FLYWHEEL RETRACTED 


V 

SBC 

DELTA 

RPM 

1 

1.10 

1.10 

54.47 

2 

3.46 

2.36 

47.70 

3 

7.25 

3.79 

41.97 

4 

12.52 

5.27 

40.42 

5 

19.55 

7.03 

34.13 

6 

28.45 

8.90 

32.13 

7 

39.55 

11.10 

27.23 

8 

53.12 

13.57 

24.30 

9 

69.45 ' 

16.32 

21.82 

10 

88.90 

19.45 

19.15 

11 

111.86 

22.96 

17.10 

12 

138.98 

27.12 

14.44 

13 

171.09 

32.12 

12.00 

14 

209.53 

38.44 

9.49 

15 

256.81 

47.28 

6.78 



FLYWHEEL EXTENDED 


REV 

SEC 

DELTA 

RPM 

1 

1.21 

1.21 

49.55 

2 

3.68 

2.47 

47.70 

3 

7.52 

3.84 

43.89 

4 

12.89 

5.38 

38.98 

5 

19.91 

7.02 

36.40 

6 

28.75 

8.84 

33.10 

7 

39.57 

10.82 

30.24 

8 

52.48 

12.91 

28.76 

9 

67.70 

15.22 

25.95 

10 

85.43 

17.73 

23.85 

11 

106.02 

20.59 

20.98 

12 

129.70 

23.68 

19.44 

13 

156.79 

27.09 

17.61 

14 

187.70 

30.91 

15.71 

15 

223.00 

35.30 

13.64 

16 

263.30 

40.30 

12.00 

17 

309.71 

46.41 

9.83 

18 

363.70 

53.98 

7.92 

19 

428.67 64.98 5.46 

FLYWHEEL OPERATING 

REV 

SEC 

DELTA 

RPM 

1 

1.66 

1.66 

36.23 

2 

3.46 

1.80 

33.25 

3 

5.45 

1.98 

30.24 

4 

7.75 

2.30 

26.03 

5 

10.33 

2.58 

23.27 

6 

13.57 

3.24 

18.51 

7 

17.64 

4.07 

14.74 

8 

22.20 

4.56 

13.15 

9 

27.36 

5.16 

11.64 

10 

33.35 

5.99 

10.01 

11 

40.27 

6.92 

8.67 

12 

48.57 

8.30 

7.23 

13 

59.38 

10.80 

5.55 

14 

77.56 

18.19 

3.30 
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APPENDIX E 


SPACE DEBRIS DATA SET 


PARTS AND THEIR MARKERS 


par t/01 , ground 
marker/ 0101 

part / 0 2 , m a s s = 2 0 0 0 , cm = 0 2 0 1 , q g = 0 ,0,0, r e u 1 e r = 0 , 0 , 0 
, i p =70 0 0 , 70 0 0 , SO 0 0 , 0,0, 0 
, wz =5 

marker/0201 

marker/020211 , qp=Q , 3.0, 0 , re uler=0 , SOD , SOD 

mark er/0 28 , q p =0 , 1 , 6 

mar k er/0 2S , q p =0 ,-1,0 

mark er/0 21 0 , q p =1 , 0 , 0 

marker/0211 , qp=-i ,0,0 


mark er/0 20 21 2 

>qp*0 f 


5,0, r eu 1 er =0 , SO D , SO D 

mark er/0 20 22 , 

qp=0 , 

o 

-0 .2 

marker / 020 3 , 

qp=0 , 

o , 

0 

mark er/0 20 41 , 

qp=0 , 

0 , 

2.0 

mark er/0 20 51 , 

qp=0 , 

o 

2.0 

mark er/0 2061 , 

qp=0 , 


0 

mark er/0 20 71 , 

qp=0 , 

' I 

o 

marker/02042 , 

qp=0 , 

o, 

-2.0 

m a r k e r / 0 2 0 5 2 , 

qp=0 , 

3, 

-2 . 0 

m a r k e r / 02062, 

qp=0 , 

5, 

-0 . 2 

m arker / 02072, 

qp=0 , 


-0 .2 

part/03, mass 

= 20 , 

cm 

=0301 , qg=-0 . 03 , 3 . 5 , 0 , reuler = 

, ip=3,3,5.0,0 

, 0 , 0 



marker/0301 




marker/03011 , 

qp= o 


0 , 0 , r eu 1 er = SO D , 1 30 D , SO D 

m ark er / 0 3 0 2 , 

qp= o 

. 0 3 

, 0 , 0 , r eu 1 er =— SO D , 0 , 0 

marker/0303 , 

qp= 0 


-0.03, O', 

mar k e r / 0 u 4 , 

qp—0 

,03 

, 0 , 0 

mark er/0 30 5 , 

qp= 0 

> 

0 . 0 3 , 0 


marker/ 

<J -2- i. , 

qp=0 . 

5,0 

m a r k e r / 

' 0 3 2 , 

q p = * 

CT 

!• 

marker/ 

t* ~ ■ “ 

-• ■— 1 ' , 

n n = — fl 

i r 

* f 

mar k er/ 

034, 

qp=0 , 

=• n 


part/04, mass=2, cm=04011, qg=0,3.5,0, r euler=0 , 0 , 0 
, i p =0 . 5 , 0 . 5 , 0 . 5 , 0,0, 0 
rr» *5 r k 0 r / 0 4 0 1 1 

mark er/0 40 12 , qp = 0 , 0 , 0 , reuler =0 , 900 , SOD 
mark er/0 40 2 , q p =-6 . 0 3 , 0 , 0 , r eu I er =90 D , 1 80 D , 0 
mark e r / 0 4 0 3 % q p — 0 * 0 , 0 , r e u 1 e r = 0 , S 0 D , S 0 D 


1 


CONSTRAINTS 


! j 0 i n t/99 , 1=0 30 2 « j =020212 

! , rackpin , p d=0 . 03 

gear / 1 , j 0 1 n t = = 2 4 , 3 4 « c y = 0 4 0 3 

join t/24 , i =020212 , j =04012, tr anal at 1 onai 

join t/34 , i =0 30 11, j =0 40 2 , r ey 0 lute 



reques t/01 , 

di splaceman t , 

i 

=0 201 , 

j 

=0101 

request/OS, 

veioci ty , 

i 

=0 201 , 


=0101 

request / 0 3 , 

ar-ceierat i on , 

i 

= 0201 , 

i 

=0101 

reques t/0 4 ; 

di spi seamen t , 

i 

=0 301 , 

j 

=0201 

reques t/0 5 , 

velocity , 

i 

=0 301 , 

j 

=0 201 

req ues t/0 S , 

acceler at i on , 

i 

=0 30 1 , 

j 

=0201 


! GRAPHICS OUTPUT 

graphi es/li 

,ou tl i ne=020211 , 02061 , 02071 , 02072 , 02062 , 02022 ,020211 

gr aphi cs/22 
, cy 1 i nder 

,cm=0 203, r ad i u 5=3 
, leng t h=2 , sides=40, seg=4Q 

graphi cs/33 
, c y 1 i n der 

, crn=0 20 3 , r ad i u s=3 
, length=-2, sides=40, seg=4Q 

graphi cs/44 

, n u 1 i nder 

,cm=0301 , radi us=0 . 5 
,length=0 . 2 , =ides=40, seg=4Q 

graphi cs/55 

, o u 1 1 i n e=0 30 2 , 0 30 4 , 0 30 2 
graphi cs/66 

, o u 1 1 i n a = 0 3 0 3 , 0 3 05,0 3 0 3 

gr aphi c-s/77 
, o u 1 1 i n e=0 28 , 0 2'3 , 0 23 

graphi cs/83 

, o u 1 1 i n e=0 210 , 0 21 1 , 0 210 

graphi ca/9? 

, o u ? 1 i n e=0 31 , 0 33 , 0 31 

graphi c s/1 11 
, o u 1 1 i n a=0 32 , 0 34 , 0 32 


0 ij t p U t / g V 3 a M 5 , r pq sa u e 

result s/f o rrna t ted 

, corn men t= space debr i s at t enuat i on data 
debug/ dump , verbose , dof , topology 


en d 






fiPArr DFRR I 

DATA S 

ET 

1 

par t/01 , groan 
mark er/0101 

part/02, mass 

d 

= 200 0 , 

PARTS AND THEIR. MARKERS 
cm=G 20 1 , q q=0 , 0 , 0 , r eu 1 er =0 , 0 , 0 

, i p=7000 , 7000 

, 30 0 0 , 

0 t 0 , 0 

,W2=-5 
marker/0201 
marker / 0 20211 

. qp=o , 

3.0,0, r eu 1 e r =0 , 30 D , 30 D 

marker/023 , 

qp=0 , 

1,0 

marker/023, 

qp=0 , 

-1,0 

marker/0210 , 

qp=i j 

0 , 0 

marker/0211 , 

qp = -l 

, 0 , 0 

mar k er/C 20 21 7 

,.qp=o , 

3.5,0, r eu 1 er =0 , 30 D , 30 D 

mark e r / 0 2022 , 

qp=o , 

3 , -0 . 2 

marker/0203 , 

q p =o , 

0 , 0 

marker/02041 , 

qp=0 , 

0 , 2 . 0 

marker/02051 , 

qp=0 , 

3 , 2.0 

m a r k e r / u 2 0 t 1 , 

qp=o , 

5 , 0 

marker/02071 , 

qp=0 , 

7, 0 

marker / 0 2 042, 

qp = 0 , 

0 , -2 . 0 

mar k er/0 20 52 , 

qp=o , 

3, -2 . 0 

marker/02062 , 

qp=0 , 

5 , -0.2 

mark er/0 20 72 , 

n n = H . 

nr - J 

7 , —0 . 2 


par t/03 , mass =20 , cm=0301 , qg=-0 . 03 ,3.5, 0 , reuler=u , 0 , 0 

, ip =3, 3, 5. 0,0, 0,0 


mark *r,* 

'■'0 301 






marker,- 

'■'0 3011 ; 

qp = 

o 

, 0, 

0 , 

r eu 1 er = 30 D , 1 30 D , 30 D 

mark er,- 

-0302, 

qn = 

o 

. 03 , 0 , 

0 , 

r euier=-30D , 0 , 0 

mark e r 

0 3 0 3 , 

n n = 

n r 

o 

* “ u * 0 < 

o, 


rn a r k e r 

"0 30 4 « 

qn = 

-o 

. 03 , 0 , 

o 


marker/ 

• ft . 

n n =■ 

*i r 

o 

, 0 . 0 3 , 

o 



part/04, mas 3=2, cm=0401i, qg=0 ,3.5,0 , reuler=0 ,0,0 


, i p=3 , 

5,5, 0 

, 0 , 0 


rn ark. e r 

/04011 



mark er 

/ 0 40 12 

,qp=0 ,0 

, 0 , r e u 1 e r =0 , 30 D , 30 D 

mark er 

/0 402, 

q r = — 0 . 

0 3 , 0 , 0 , r eu 1 er =30 D , 1 SO D , 0 

marker 

/0 403 , 

qp=0 ,0 

, 0 , r eu I er =0 , 30 D , 30 D 

i 



CONSTRAINTS 

1 

1 



j o i n t/33 , i =0 30 2 , j =0 2 
, rackpin, pd=0.03 


ge sr/I , j o i n t s=24 , 34 , cv =040 3 

joint/24, i =0 20212 , j =04012 , translational 

2 o i n t/34 , i =0 30 11, j =0 40 2 , r ev o lute 


REQUEST OUTPUT 



request/ 

04, 

di spia 

cemen t , 

i 

= 0 

301 

reques t.- 

/ 1" cr 

u *=? x 0 C 1 

t y 

1 

= 0 

301 

r eq u e s t / 

-0 6 , 

accele 

ration, 

i 

=0 

301 


j =0201 
j =0201 
j =020 1 


GRAPHICS OUTPUT 


gr ap h i cs/ 1 1 

, o u t i i n 5=0 20 21 1 , 0 20 SI , 0 20 71,0 20 72 , 020 62 , 0 20 22 , 0 


graphics/ 22 
, cy 1 i n der 

, cm=0 20 3 , r ad i u 5=3 
, 1 sng th=2 , sides=40, seg=40 

gr ap h i os/ 3 3 
, cyl i nder 

, cm=0 20 3 , r ad i u s = 3 
, lsngth=-2 , s i dss=40 , seg=40 


graphi cs/44 
, cy 1 i n der 

, cm=0 30 1 , r ad i u s =0 . 5 
, 1 sn g r h=0 .2, si dss=40 , ssg=40 

graphi cs/55 

, o u 1 1 i n a=0 30 2 , 0 30 4 , 0 30 2 


graphi c s/ 6 6 

, o u t 1 i n e = 0 3 0 3 , 0 3 0 5 , 0 3 0 3 


graphics/77 
, ou ?i i ne=02S , 023 , 023 


graphi cs/38 

, o u 1 1 i n a=0 21 0 , 0 211 , 0 21 0 


o u t p u t / g r •=■ a y a f r a q ■=• a y e 
resul t s/ f o r rn a t tad 

, cornmen t = s p ace debr i s at t en u a t i o n da t a 

d e b u g/ d u rn p , y e r b o s e , d o f , t o p o 1 o g y 

end 



SPACE DEBRIS DATA SET 


PARTS AND THEIR MARKERS 


par t/Ql , ground 
marker/0101 


par t / 0 2 , m a a •=* 

=2000 , 

err 

= 0 201 , 

q 3 = 0 , 0 , 0 , reui 

er =0 , 0 , 0 

, i p=62Q0 , 7100 

,330 0 , 

1 0 0 

,100,1 

0 0 


5 j A .i j = 5 






marker/0201 

marker/020211 

,qp=0 , 

3 . 

0,0, r 

eu 1 er =0 , 30 D , 30 D 


marker/023 , qp 

=0,1 , 0 





marker/023 , qp 

= 0 , -1 , 

0 




marker/0210 , qp=l ,0 , 

0 




mark er/Q 21 1 , q 

P—1,0 

,0 




marker/020212 

»qp=o , 

o 

5,0, r 

euler=0 , 30 D , 30 D 


mar k er/ 0 2 0 22 , 

qp=0 , 


-0 . 2 



marker/0203 , 

qp=0 , 

0 . 

0 



mark er/0 20 41 , 

qp=0 , 

o , 

2.0 



marker/02051 , 

qp=0 , 

3, 

2.0 



marker / 0 2 0 £ 1 , 

qp =o , 

5 i 

0 



mar k. er/0 20 71 , 

qp=0 , 

t j 

o 



mar k er/0 20 42 , 

qp=0 , 

0 , 

-2 . 0 



m arker / 02052, 

q p = o , 


-2 . 0 



m arker / u 2 o £ 2 , 

qp=0 , 


-0 .2 



m a r k e r / 0 2 0 7 2 , 

qp=0 , 

/ f 

— 0 , 2 



part/03, mass 

=20 i 

cm 

=0301 , 

qg=-0 .03,3.5,0 

, r euler =0 , 0 , 0 

, ip=3,3,5.0 ,0 
mark, er/0 301 

, 0 , 0 





m arker / 0 3 Oil , 

q P = 0 

ii 

o, 

0, reuier= S'O D 

, 130D , 30 D 

mark, er/0 30 2, 

q P = 0 

, 0 3 

, 0 , 

0 , r eu 1 e r = — 30 D 

,0,0 

marker/ 0303 , 

qp= 0 


-0 , 0 3 , 

0 , 


mark. er/0 30 4 , 

qp— 0 

, 0 3 

, 0 , 

o 


mark er/0 30 5, 

qp* 0 

j 

0.03, 

o 



P sr ?/ 0 4 , friai = =2 , crn=0 40 1 1 , q g=0 ,3.5,0, r eu 1 er =0 , 0 , 0 
, i p =0 . 5 , 0 . 5 , 0 . 5 , 0 ,0,0 
m arker / 0 4011 

m a r k a r / 0 4 0 1 2 , q p =0,0,0, r e u 1 a r = 0 , 3 0 D , '? 0 D 
mar k er/0 2 , q p =-0 .03,0, 0 , r ay 1 er =50 D , 1 SO D , 0 
m arker /" 0 4 0 3 , q p = 0 ,0,0, reuler= 0 , S 1 0 D , 3 0 D 


CONSTRAINTS 


! j o i n t/33 , i =0302 , j =020212 

■ , r ack pin, p d=0 . 0 3 

ge ar/1 , j o i n t s=24 , 34 , cm =0 40 3 

join t/24 , 1=020212, j =04012, translational 

joint/34, i=03011, j=0402, reuolute 


REQUEST OUTPUT 



3 =0201 
j =0 20 1 
j =0201 


requea t/0 4 , 
rsques t/0 5 , 
r aquas t/0 5 , 


di spiacemen t , 
veloci ty , 
3 c c e 1 a r 3 1 1 o n , 


i =0301 , 
l =0301 , 
l =0 301 , 


GRAPHICS 01 


PUT 


% u 1 1 i n e=0 20 211 , 0 20 61 , 0 20 71 , 0 20 72 , 0 20 62 , 0 2022, 0 20 21 1 


g rap hi cs/22 
, cyl i nder 

, cm=0 20 3 , r ad i u s=3 
, length=2 , •=• i des = 4ij , s a g = 4 0 

gr aphi cs/33 
, cyl i nder 

, cm=0 20 3 , radius=3 
,length=-2, s i des=40 , seg=4u 


graph! cs/44 
, cy 1 1 nder 

, cm=0 30 1 j r ad i u s=U • 5 
, length=0 . 2 , sides=40, seg=40 


qraphi cs/55 

~ o u 1 1 i n a = 0 3 0 2 , 0 3 0 4,03 0 2 


graph! cs/SS 

, outlines n 3 0 3 , 0 3 05,0 3 0 3 


graphics 

.outline 


~ou tl i ne=0210 , 0211 , 0210 



o u t p u t / 3 r s a m e,rs q s a m e 
r esu 1 t s/f o rma t ted 

f c o mm ent = space debris a 1 1 e n u a t i o n data 
debu g/ dump , yerbo se i do f , t o p o 1 o g y 


end 



PARTS 


SPACE DEBRIS DATA SET 


AND THEIR MARKERS 


par t/01 , ground 
rn a r k a >• / 0 1 0 1 


par t/'O 

2 , mass* 

=2000 

, cm =0201, 

n a — 0 

-i 

, 0,0, reule 

r 

=0 , 0 

; 0 

, i n = 7fi f! fl , 7n 0 0 

? - r* .---j.--- 

, 300 0 

,0,0 , 0 






, u i z = 5 









rn a r k *5 r 

/O 20 1 








marker 

/0 20 211 

,qp=0 

, 3 , 0 , 0 • r 

eu 1 er 

=0 , 30 D , 90 D 




marker 

/028. 

qp=0 

, 1 , 0 






marker 

/o 23 , 

qp=0 

,-1,0 






mark er 

/0210 , 

qp=l 

, 0 , 0 






marker 

/021 1 , 

qp = - 

1 , 0 , 0 






marker 

/o 20 21 2 

,qp=0 

} 3.5,0, r 

e 1 j 1 e r 

=0 , SO D , SO D 




marker 

o ^ 0 •- - ? 

qp=0 

, 3 , -0 . 2 






marker 

/Q203 , 

qp=0 

- 0 , 0 






mark er 

/0 204i ? 

qp=0 

, 0, 2.0 






mark er 

/'0 2051 , 

qp=0 

, 3, 2.0 






m a r k e r 

/0 20 51 ; 

qp=0 

,5, 0 






marker 

/ o 20 71 ? 

qp=0 

i ? j 0 






marker 

/02042 , 

qp=0 

, 0, -2.0 






m arke r 

/'02052 , 

qp=0 

, 3, -2.0 






marker 

/0 20 62 , 

qn=Q 

, 5, -0.2 






marker 

/02072 , 

qp=0 

, 7, -0.2 






par t/0 

3 5 mass 

= 30 * 

cm=0 301 , 

q 9 = - 

0 . 0 3 ,3.5, 0 , 


r eul 

er =0 

, i p =1 2 

■1 T = 

jl A C. | i. • J j 

0 f 0 , 0 







m arke r 

/0 30 1 








marker 

/0 3011 , 

n n = 

-t r 

0 , 0 , 

0, r 

e u 1 s r = 90 D, 


30 D , 

SOD 

rn a r k e r 

/0302, ' 

qp = 

0 . 0 3 , 0 , 

0 , r 

euler =-90 D , 

0 

,0 


mar k er 

' 0 30 3 . 

qp = 

0, -0.03, 

0 ; 





m a r k e r 

/ 0 3 0 4 , 

qp=- 

0 . 0 3 , 0 , 

o 





m arke r 

/ o 3 0 5 , 

q? = 

0 , 0 . 0 3 , 

o 






p ar t/'O 4, mas 

s=2, cm —040 

11? 0 

,3.5,0, r euler =0 

, - — A cr ri <=. 

fi c n n i*i 



5 1 r * - i - * - t 

■J , , >J , U , U 



mar k e r / u 4 u 1 1 




mar kar / n 4 0 1 2 

, qp=0 , 0 , 0 , 

r e u i e r = 0 

, SOD, SOD 

m a r k e r / 0 4 0 2 , 

q p = — 0 . 03 , 0 

, 0 , r eul 

er=S0D , 130D , 0 

m arke r / 0 4 0 3 , 

qp=0 , 0 , 0 , 

r euler =0 

, SOD , SOD 


CONSTRAINTS 


j o i n t/SS ,1=0 30 2 , j =0 20 21 2 
, r ack p i n , p d=0 . 0 3 


j o i n t s = 2 4 , 3 4 , cv=G403 
joi.nt/24, 1=020212, j =04012, translational 
j o : - : 34 , l =0 30 11, j =0 40 2 , rsM o 1 u t e 


REQUEST QUTPU1 




•=■ • -j ■ J -=• =• 


reques t. 



di •= placemen t , 
y eioci t y , 

acceier at i on , 


i =0301 , j =0201 
i=0301, j=02Gl 


GRAPHICS 


OUT 


UT 


graphi cs/11 

, ou ti i n •5=0 20 211 , 02061 , 02071 , 020 


, 0 2 0 6 2 , 02022,020211 


graphi cs/22 
, cy 1 i nder 

, cm=0203, radius=3 
, length=2, sides=40, seg=40 

graphi cs/33 
, cy 1 i nder 

, cm=Q 20 3 , r ad i u s=3 
, length=-2, sides=40, =eg=40 

graphics/44 
, cy 1 i nder 

, cm=0 30 1 , r ad i u s=0 . 5 
, 1 e n g £ h = 0 ■ , s i d e s = 4 u , s e g = 4 U 


gr aphi cs/55 

, O u 1 1 i n e=0 30 2 , 0 30 4 , 0 30 2 


gr aphi ca/66 

, o u 1 1 i n e = 0 3 0 3 , 0 3 0 5 , 0 3 0 3 


graphi ce/77 
, ou 1 1 i n e=0 28 , 0 29 , 0 23 

gr aphi cs/88 

, o Util n e=0 21 0 , 0211 , 0 210 


o u t p u t / g r = a v cj s *3 m 0 


resul ts/format ted 

, c 0 mmen t = = p ac e debris 3 1 1 e n u a 1 1 o n d a t a 
d e b u q/ d u m p , y gf h 0 50 • d o f } t o p o i o g y 


end 



DATA set 


SPACE DEBRIS 


PARTS AND THEIR. MARKERS 


par t/0 1 , ground 
mar ker/0101 

p ar t/0 2 , mas = =20 1 0 , cm=0 20 1 , q g=0 ,0,0, r eu 1 er =0 , 0 , 0 
, i p =70 0 0 , 70 0 0 , 30 0 0 , 0 , 0 , 1 0 0 


mar ker/0201 


mark er 

/0 

20 21 

i . qp 

marker 

/Q 

“r ,-r 
fl - w f 

qp 

marker 

/0 

23 , 

qp 

marker 

/o 

210 , 

qp 

marker 

/o 

211 , 

qp 

marker. 

/n 

2021 

2 , qp 

marker 

/O 

2022 

> qp 

marker 

/O 

20 3, 

qp 

marker 

/0 

2041 

» qp 

marker 

/o 

2051 

, qp 

marker 

/0 

2061 

, qp 

marker 

/o 

20 71 

» qp 

marker 

/o 

20 42 

, qp 

marker 

/o 

2052 

, qp 

marker 

/0 

2062 

, qp 

marker 

/o 

20 72 

, qp 

part / 0 

, 

mas 

s=20 

i ip=3, 

J 

5.0, 

0 , 0 , 

marker. 

/0 

301 


marker. 

/ n 

3011 

, qp 

marker. 

/o 

302, 

qp 

marker. 

/ 0 

30 3 , 

qp 

marker. 

/Q 

304, 

qp 

mar k er. 

/ o 

30 5 , 

n n 

r 

n ar t/0 

4, 

mss 

.- ■” 

. i n =!“! , 

£=■ 

0.5, 

0 . 5 , 

m a rker , 

■'0 

4011 


marker. 

/o 

4012 

. qp =l 

mark er. 

/ o 

40 2 . 

qp=' 

marker, 

/Ti 

40 3, 

qp® 1 


reuler =0 , 30 D , 90 D 


, 0 , 0 


=n 


r eu 1 ar =0 , 30 D , 30 D 


=n 


=0 

=ll 


=0 


o 

o 

o 


} 

s! 

7 , 
0 . 


- 0 . 2 

o 

2 . 0 
2.0 
0 
o 

- 2.0 
-2 . 0 
- 0 . 2 
-0 . 2 


cm=0 30 1 , q g=-0 , 0 3 , 3 . 5 , 0 , r eu I er =0 , 0 
0, 0, re uler= 30 D , 1S0D , 30 D 


u f 

0,03, 

0. -0.03 


0, 


r su 1 <=*r =—90 Q , fl 


0 

n 


g=0 ,3.5,0, r eu 1 er =0 ,0,0 


CONSTRA I NTS 


j o i n t/33 , i =0 30 2 , j =0 20 21 
, rackpin, pd=0.G3 


•gear / 1 , j o i n t s = 2 4 , 3 4 , c y = 0 4 0 3 

joint/24, 1=020212, j =04012, translational 

j o i n t/34 , i =0 30 11, j =0 40 2 , r eu o lute 




REQUEST OUTPUT 

1 a cam an ? • =n 20 1 , : =0 i 0 1 


request/04, 

di spiacemen t , 

i 

=0 

301, 

J 

= 0201 

reques t/05 , 

veloci ty , 

i 

= 0 

301 , 

3 

=0201 

r 0q u he t 0 S , 

acceier a t i on , 

i 

ti 

301 , 

3 

=0 201 


GRAPHICS OUTPUT 


graphi cs/11 

, o u t 1 i n e=0 20 21 1 , 0 20 SI , 0 20 71 , 0 20 72 , 020 S2 


2022,020211 


graphic s/22 
, cy 1 i nder 

, cm=0 203, r ad i u 5=3 
, lenqt h=2 , sides=40, seg=40 

graphi cs/33 
, cy 1 i nder 

, cm=0 203, r ad i u 5=3 
,length=-2, 5ides=40, seg=40 

graphi cs/44 
, cy 1 i nder 

, cm=0 30 1 , r ad i u 5=0 . 5 
, length=0.2, s i des=40 , seg=40 

graphi cs/55 

, o u 1 1 i n e=0 30 2,0304, 0 30 2 
graphi cs/SS 

, o u t 1 i n e=0 30 3 , 0 305, 0 30 3 


graphi cs 
, o u t 1 i n e 

, o u 1 1 i n e=0 21 0 ,0211 ,021 0 



o u t p u t / g r a a m e , r e q s a v e 
resul t s/format ted 

, comrnen t = space debris attenuation data 
d e b u g/ d u rn p , v e r b o 5 e , d o f , t o p o 1 o g y 


end 



10 DIM TIME <£000 ) 

£0 CLS: X=1 

30 0PEN"c : \ 1£3\1£3. f i 1 \data. prn'' FOR OUTPUT AS #1 
AO A*= INKEY* : TIME ( X ) =TIMER : IF A*=" M THEN AO 

50 PRINT X, TIME (X) -TIME ( 1 ) , TIME (X) -TIME (X-l ) , 60/ (TIME ( X ) -TIME ( X-l ) ) 

60 PRINT #1, X, TIME (X) -TIME (1), TIME (X) -TIME (X-l) , 60/ (TIME (X ) -TIME ( X-l ) ) 
70 X=X+1 

80 IF A*=CHR*(£7) THEN 100 

90 GOTO AO 

100 CLOSE : SHELL "1 £3" 

110 GOTO £0 
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Features 


• QUICK AND EASY ASSEMBLY 

• NO SIGNAL ADJUSTMENT REQUIRED 

• LOW COST 

• SMALL SIZE 

• HIGH PERFORMANCE 

• HIGH RESOLUTION 

• INSENSITIVE TO RADIAL AND AXIAL PLAY 

• -40° C TO 100° C OPERATING TEMPERATURE 

• TWO CHANNEL QUADRATURE OUTPUT 

• TTL COMPATIBLE OUTPUTS 

• SINGLE 5 V SUPPLY 


Description 


The HEDS-5500 is a high performance, tow cost, optical 
incremental encoder which emphasizes high reliability, 
high resolution and easy assembly. 

The encoder contains a lensed LED light source, an inte- 
grated circuit with detectors and output circuitry, and a 
code wheel which rotates between the emitter and detector 
1C. The outputs of the encoder are two square waves in 
quadrature. The collimated light and special photodetector 
configuration ailow for high resolution and excellent en- 
coding performance as well as increased long life reliability. 




The encoder may be quickly and easily mounted onto a 
motor No mechanical or electrical adjustments are re- 
quired. 

The two channel digital outputs and the single 5 V supply 
input are accessed through 0.025 inch square pins located 
on 0.1 inch centers. 


Applications 


The HEDS-5500 provides motion detection at a low cost, 
making it ideal for high volume applications. Typical 
applications include printers, plotters, tape drives, pos- 
itioning tables and automatic handlers. 

ESD WARNING: NORMAL HANDLING PRECAUTIONS 
SHOULD BE TAKEN TO AVOID STATIC DISCHARGE. 


Outline Drawing 





Block Diagram 



Theory of Operation 

The HEDS-5500 translates rotary motion of a shaft into a 
two channel digital quadrature output. 

As seen in the block diagram, the HEDS-5500 encoder 
contains a single Light Emitting Diode (LED) as its emitter 
The light is collimated into a parallel beam by means of a 
single lens located directly over the LED. Opposite the 
emitter is an integrated detector circuit. This 1C consists of 
multiple sets of photodetectors and the signal processing 
circuitry necessary to produce the digital waveforms. 

The code wheel rotates between the emitter and detector 
causing the light beam to be interrupted by the code 
wheel’s pattern of spaces and bars. The photodiodes which 
detect these interruptions are arranged in a pattern that 
corresponds to the radius and design of the code wheel. 
These detectors are also spaced such that a light period 
on one pair of detectors corresponds to a dark period on 
the adjacent pair of detectors. The photodiode outputs are 
then fed through the signal processing circuitry resulting 
in A. A. B and B. Two comparators receive these signals 
and produce the final outputs for channels A and B. Due 
to this integrated phasing technique, the digital output of 
channel A is in quadrature with that of channel B (90 
degrees out of phase). 

Definitions 

Count (N): The number of bar and window pairs or counts 
per revolution (CPR) of the code wheel. 

Electrical Degree (°e): The dimension of one bar and 
window pair divided by 360. 

1 Cycle (C): 360 electrical degrees (°e), 1 bar and window 
pair. 


Output Waveforms 



1 Shaft Rotation; 360 mechanical degrees. N cycles* 

Position Error (AH): The normalized angular difference 
between the actual shaft position and its position as in- 
dicated by the encoder cycle count. 

Cycle Error (AC): An indication of cycle uniformity. The 
difference between an observed shaft angle which gives 
rise to one electrical cycle, and the nominal angular in- 
crement of t/N of a revolution. 

Pulse Width (P): The number of electrical degrees that an 
output is high during 1 cycle. This value is nominally 
180°e or 1/2 cycle. 

Pulse Width Error (AP): The deviation, in electrical de- 
grees, of the pulse width from its ideal value of 180° e. 

State Width (S): The number of electrical degrees between 
a transition in the output of channel A and the neighboring 
transition in the output of channel B. There are 4 states 
per cycle, each nominally 90° e. 

State Width Error (AS): The deviation, in electrical degrees, 
of each state width from its ideal value of 90° e. 

Phase (<t>): The number of electrical degrees between the 
center of the high state of channel A and the center of the 
high state of channel B. This value is nominally 90° e for 
quadrature output. 

Phase Error (A<2>): The deviation of the phase from its ideal 
value of 90° e. 

Direction of Rotation: When the code wheel rotates in the 
counterclockwise direction (as viewed from the encoder 
end of the motor), channel A will lead channel B. When 
the code wheel rotates in the clockwise direction, channel 
B will lead channel A. 
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HEWLETT 

PACKARD 


GENERAL PURPOSE 
MOTION CONTROL 1C 


HCTl-1000 


TECHNICAL DATA DECEMBER '987 


Features 

• DC, DC BRUSHLESS AND STEPPER MOTOR 
CONTROL 

• POSITION CONTROL 

• VELOCITY CONTROL 

• PROGRAMMABLE VELOCITY PROFILING 

• PROGRAMMABLE DIGITAL FILTER 

• PROGRAMMABLE COMMUTATOR 

• PROGRAMMABLE PHASE OVERLAP 

• PROGRAMMABLE PHASE ADVANCE 

• GENERAL 8 BIT PARALLEL I/O PORT 

• 8 BIT PARALLEL MOTOR COMMAND PORT 

• PWM MOTOR COMMAND PORT 

. QUADRATURE DECODER FOR ENCODER 
SIGNALS 

• 24 BIT POSITION COUNTER 

• SINGLE 5 V POWER SUPPLY 

• TTL COMPATIBLE 

• 1 OR 2 MHz CLOCK OPERATION 


Package Dimensions 


ORIENTATION NOTCH; 
- SHAPE MAY VARY 


'OTT 

/ 

PIN NO. 1 10 


NOTES: 

M. EACH PIN CENTERLINE TO BE LOCATED 
WITHIN 0,010" OF ITS TRUE 
LONGITUOINAL POSITION. 

Z LEAD FINISH: SOLDER COAT 


!■* 2.060 i 0.010 

hh -*-0.080 i 0.010 

4 L “HF 

1 0.018 t ^ 


SEATING 

PLANE 


0.200 MAX \ 
1 0.02 MIN 


0.600 t 0.010 
C TOC 
OP BEND R 



0.125 MIN 
0- 


0.63 * 0.02 
,N — croc - 

- is" — Hh— 


40-PIN PLASTIC DUAL INLINE PACKAGE . 

General Description 

The HCTL-1000 is a high performance, general purpose 
motion control 1C fabricated m Hewlett-PacKard NMOS 
technology it performs all the time-mtensive tasks of digital 
motion control thereby freeing the host processor for 
other tasks The simple programmability of all control 
parameters provides the user with maximum flexibility and 


nc*C i 

AOo/OBoC 2 
AOi/DBi C 3 
AD 2 /OB 2 C * 
AD 3 /D02 C 5 
AO 4 /OB 4 C 6 

AD*/DB* C 7 

DB«C 8 
OB 7 C 9 
v«C 10 
VccC 11 
propC 12 
INITC n 

cmrz i* 

5TCPC 15 
PULSE C 16 

signC 17 

MCoC 18 
MCiC 19 


40 I] 5? 

39 

38 ^ SEE 

37 3 R/ * 

36 3 RESET 
35 3Vcc 
34 3EXTCLK 
33 □ 

32 3 V U 
31 3CHA 
30 3CH0 
29 3 PH ° 

28 3 PHC 
27 3 PHB 
26 3 PHA 

25 3 

24 3 M C« 

23 3 M <^ 

22 3MC4 
21 3«Cl 


HOST 

PROCESSOR 



MC 2 L | 20 21 [ J MC 

# SHOULD BE LEFT FLOATING 

PINOUT 


Figure 1. System Block 
Diagram 


quick design of control systems with a minimum number 
of components. All that is needed for a complete servo 
system is a host processor to specify commands, an 
amplifier and motor with an incremental encoder No 
analog compensation or velocity feedback is necessary 
(see Figure 1 ). 


Table of Contents 

General Description 1 

Theory of Operation 2 

Absolute Maximum Ratings 3 

DC Characteristics 3 

AC Characteristics 4 

Timing Diagrams 5 

Functional Pin Description 9 

Operation of the HCTL-fOOO *0 

— User Accessible Registers 10 

— Operating Modes 12 

— Commutator 17 

Interfacing the HCTL-1000 20 

— I/O Interface 20 

— Encoder interface 20 

— Amplifier Interface 21 


ESD WARNING: Since this is an NMOS device, normal 
precautions should be taken to avoid static damage. 


OF POOR QUALITY 





The purpose of this section is to describe the organization 
of this data sheet The front page includes the key features 
of the HCTL-1000. a general description of the part, the 
mechanical drawing and pm-out. and a Table of Contents. 
Following this section is the Theory of Operation, which 
gives the user a brief overview of how the HCTL-1000 oper- 
ates by describing the internal block diagram shown in 
Figure 2. The following five sections give the specifications 
of the HCTL-1000. including Absolute Maximum Ratings. 
DC Characteristics. AC Characteristics. Timing Diagrams, 
and Functional Pm Descriptions. The final two sections 
include the detailed information on how to operate and 
interface to the HCTL-1000. The How to Operate section 
discusses the function and address of each software regis- 
ter and describes how to use the four position and velocity 
control modes and the electronic commutator The How to 
interface section describes how to interface the HCTL-1000 
to a microprocessor, an encoder and an amplifier 


The HCTL-1000 is a general purpose motor controller 
which provides position and velocity control for dc. dc 
brushless and stepper motors The internal block diagram 
of the HCTL-1000 is shown m Figure 2 The HCTL-1000 
receives it input commands from a host processor and 
position feedback from an incremental encoder with quad- 
rature output. An 8-bit directional multiplexed address data 
bus interfaces the HCTL-1000 to the host processor The 
encoder feedback is decoded into quadrature counts and 
a 24-bit counter keeps track of position The HCTL-1000 
executes any one of four control algorithms selected by 
the user. The four control modes are 

• Position Control 

• Proportional Velocity Control 

• Trapezoidal Profile Control for point to point moves 

• integral Velocity Control with continuous velocity profiling 
using linear acceleration 





a 

a 

a 

i 

« 

a 

a 


i 

I 


The resident Position Profile Generator calculates the 
necessary profiles for Trapezoidal Profile Control and 
Integral Velocity Control. The HCTL-1000 compares the 
desired position (or velocity) to the actual position (or 
velocity) to compute compensated motor commands using 
a programmable digital filter D(z). The motor command is 
externally available at the Motor Command port as an 8- 
bit byte and at the PWM port as a Pulse Width Modulated 
( PWM) signal. 

The HCTL-1000 has the capability of providing electronic 
commutation for dc brushless and stepper motors. Using 
the encoder position information, the motor phases are 
enabled in the correct sequence. The commutator is fully 
programmable to encompass most motor encoder com- 
binations. In addition, phase overlap and phase advance 
can be programmed to improve torque ripple and high 
speed performance. The HCTL-1000 contains a number of 
flags including two externally available flags. Profile and 
Initialization, which allow the user to see or check the 
statu s of the c ontroller It also has two emergency flags. 
Limit and Stop, which allow operation of the HCTL-1000 to 
be interrupted under emergency conditions. 

The HCTL-1000 controller is a digitally sampled data system. 
While information from the host processor is accepted 
asynchronously with respect to the control functions, the 
motor command is computed on a discrete sample time 
basis. The sample timer is programmable. 


Absolute Maximum Ratings 


Operating Temperature O' C to 70° C 

Storage Temperature -4Q : C to -^S'C 

Supply Voltage -0 3 V to 7 v 

Input Voltage -0 3 V to 7 V 

Maximum Power Dissioation 0 95 W 

Maximum Clock Frequency 2 MHz 


D.c. Characteristics 


T a = 0° C to -70° C. V cc = 5 V r 5 0/ o: V ss = 0 V 


^ Parameter 

Symbol i 

Min. 

TVp. 

Max. 

Units 

Test Conditions 

| Power Supply 

Vcc i 

4.75 

5.00 

5.25 

! v 

T ! 

i 

1 Supply Current 

Ice 

80 

180 

| mA 

1 

: Input Leakage Current 

1 lil 


i i 

10 

i mA 

V, N = 5.25 V 1 

Tristate Output 
j Leakage Current 



; | 

±10 

1 " A 

V out = -0.3 to 5.25 V 

Input Low Voltage 

! v, L 

-0.3 

- j 


0.8 

V 

, 

t Input High Voltage 

! v,„ j 

2.0 | 

i 

Vcc 

! v 

* , 

i Output Low Voltage 

1 Vql 

-0.3 | 

i 

mzm 

! V 

1 Ol = 2.2 mA j 

i Output High Voltage 

X 

O 

> 

2.4 i 

r 

Vcc 1 

V 

1 Ch = -200 m A 

Power Dissipation | 

P 0 


400 

950 ! 

mW 

! 

j Input Capacitance 

1 

C»N | | 

; 

i 

o 

CM 

PF 

T a - 25° C. f = 1 MHz i 

unmeasured oms 
returned to ground 


Output Capacitance Load 


Cqut 


PF 


Same as above 


100 







A.C. Electrical Characteristics t^o°c to 7 0 °c v cc - 3 v r 5% un.t S 


2 MHz 


Signal 

Clock Period 

Pulse Width, Clock High 

Pulse Wi dth. Clock Low 

Clock Rise and Fall Time 

Input Puls e Width Reset 

Input Pulse W idth Stop. Limit 

Input Pulse Width Index, Index 

Input Pulse Width CHA. CHB 

Delay CHA to CHB Transition 

In put RiserFall Time CHA. CHB, Index 

Input Rise/Fall Time Reset. ALE. CS. OS. Stop. Limit 

Input Pulse Width ALE, CS _____ 

Delay T ime. ALE Fall to CS Fall 

Delay Time. ALE Rise to CS Rise 

Address Set Up Time Before ALE Rise 

' Address Set Up Time Before CS Fall 

• Write Data Set U p Time Before CS Rise 

j Address/Data Hold Time 

Set Up Ti me, R/W Before CS Rise 

I Hold Time. R/W After CS Rise 

: Delay Tim e. Write Cycle. CS Rise to ALE Fall 

j Delay T ime. Read/Write. CS Rise to CS Fall 

! Write Cycle. ALE Fall to ALE Fall For Next Write 

1 Delay time. CS Rise to OE Fall 

1 Delay Time. OE Fall to Data Bus Valid 

I Delay Time. CS Rise to Data Bus Valid 

j Input Pul se Width OE 

i H old Time, Data Held After OE Rise 

i Delay Ti me, Read Cycle. CS Rise to ALE Fall 
| Re ad Cycle. ALE Fall to ALE Fall For Next Read 

| Output Pulse Width, PROF. I NIT. Pulse. Sign. 

I PHA-P HO. MC Port __ 

I Output flise/Fall Time, PROF. INIT. Pulse. Sign 
PHA- PHO. MC Port 

I I Delay Ti me, Clock Rise to Output Rise 

l | D elay Time. CS Rising to MC Port Valid 

5 | Hold Time. ALE High Aft er CS Rise 

5 i Pulse Width. ALE High 


Symbol 


! *CPWL 


tlPWOE 


tcSALR I 
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^**********************************************/ 

*/ 
*/ 
*/ 

* / 

*/ 

*/ 
*/ 
*/ 
*/ 
*/ 
*/ 


motion engineering 
Program Name: SAMPLE3.C Date: June 6, 1990 

Ya-Dung Pan 


J ★ * * ★ * * 

/* 

/* 

/* 

/* 

/* 

/* 

/* 

/* 

/* 

/* 

/* 

/* 

/★*****★ * ***************************** 
♦include <stdio.h> 

♦include <conio.h> 

♦define MC400 
♦include "mc.h" 


Author (s) : 


Function : 


Revision : 1.0 


Sample program uses idle control mode 
for voltage control. 




void border (int, int, int r int/ int) / 
extern void welcome {); 


main ( ) 

{ 

int axis; 
int i; 

char input [50]; 

long final_j?os; 

unsigned char max_vel; 

unsigned int acc; 

int active_axes; 

int running_f lag; 

long segment; 

long offset; 

long address; 

long voltage; 

signed char voltage__axis; 

char inchar; 

char input_buf f [ 8 0 ] ; 

char *input_line; 

long encoder [ 6] ; 


welcome ( ) ; 
clrscr ( ) ; 
print f ("This 
print f ( "idle 


program resets the controllers for 
control mode to move the specified 


4 axes, then performs an\n"); 
joints using voltage control. \n ) 


/ * This address needs to be changed for new setup */ 
segment = OxAOOOL; 
offset = OxOlOOL; 


printf ("\n") ; 

print f ( " 

printf { " I This 
printf ( 11 I 
printf (" 


program setups 
% lx : 


the controller board at memory 
%lx 


address as 


— \n") 

I \n" 
l\n", 

— \n") 


mc^init ( segment , offset); 

for (axis = 0; axis < MAX_AXES; axis++) 

{ 

mc_reset (axis) ; 

mc_set_gain (axis, 128 ) ; 



mc_set_pole (axis, 32) ; 
mc _set_zero (axis, 253) ; 

mc_set_pc (axis, IDLE) ; 
mc_clr_position (axis ) ; 

/* mc_set_command (axis , 0) ; */ 

} 


getch () ; 
clrscr ( ) ; 

border (1, 1, 80, 25, RED) ; 

window (2,2,44,13); 
border (2, 2, 44, 13, GREEN) ; 

gotoxy (2,2); 

cprintf ( "Command formats : \n" ) ; 
gotoxy (2,3) ; 

gotoxy (2,4) ; 

cprintf ("* Joint #, command (e.g. 1,100) *\n") ; 

gotoxy (2, 5) ; 

cprintf ("* where command -127 is -10 Volt, *\n") ; 

gotoxy (2,6); 

cprintf ("* 0 is 0 Volt, *\n"); 

gotoxy (2,7) ; 

cprintf ("* 127 is 10 Volt, *\n"); 

gotoxy (2,8) ; 

cprintf ("* joint 0:3 999 for exiting *\n"); 

gotoxy (2, 9) ; 

cpr int f ("*****************************************\n") ; 
cprintf ( " \n" ) ; 

window (2, 13,40,24); 
border (2,13,40, 2 4, GREEN) ; 

window (41,13,79,24) ; 
border (41, 13, 79, 24, GREEN) ; 

axis= 0; 

while (axis != 999) 

{ window (2,13,39,24) ; 
gotoxy (2,2) ; 
clreol ( ) ; 

cprintf ( "Enter command: "); 

gets (input) ; 

if (sscanf (input , "%d, %ld", &axis, Svoltage) >0 && axis < MAX_AXES 

&& voltage <= 127 && voltage >® -127) 

{ 

gotoxy (2,3); 

cprintf ("--> Move joint %d at %.2f V \n\n", axis, voltage^lO . 0/127 . 0) ; 
voltage_axis= voltage + 128; 
mc_set__motor (axis, voltage_axis ) ; 

while ( ! kbhit ( ) ) 

{ window (41, 13, 79,24); 

for (i=0 ; i<MAX_AXES; i++) 

{ 

encoder [i] = mc_get_position (i) ; 
gotoxy (2 , i+2 ) ; 

cprintf ( "encoder position %d : %ld \n". 


} 


i, encoder [i] ) ; 



else 

{ 

gotoxy (2,5); 

cpr intf ( "%c ! ! ! Wrong command, enter again !!! \n", 0x007) ; 

} 

} 


void border (int startx, int starty, int endx, int endy, int color) 

{ 

register int i; 

textcolor (color) ; 
gotoxy (1, 1) ; 

for (i=0; i<=endx-startx; i++) 
putch (OxCD) ; 

gotoxy (1, endy-starty) ; 

for (i=0; i<=endx-startx; i++) 

putch (OxCD) ; 

for (i=2; i<endy-starty ; i++) 

{ gotoxy (l,i); 
putch ( OxBA) ; 

gotoxy (endx-startx+1 , i) ; 
putch (OxBA) ; 

} 

gotoxy (1,1) ; 
putch (0xC9) ; 

gotoxy (endx-startx+1, 1) ; 
putch (OxBB) ; 
gotoxy (1, endy-starty) ; 
putch (0xC8 ) ; 

gotoxy (endx-startx+1, endy-starty) ; 
putch (OxBC) ; 

textcolor (YELLOW) ; 

} 
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motion engineering 
Program Name: SAMPLE4.C Date: June 6, 1990 

Ya-Dung Pan Revision: 2.0 


*/ 
*/ 
*/ 
*/ 
*/ 
*/ 
*/ 
*/ 
*/ 
*/ 
*/ 

/* * 7 

#include <stdio.h> 

finclude <graphics.h> 

finclude <conio.h> 


/* 

/* 

/* 

/* 

/* 

/* 

/* 

/* 

/* 

/* 

/* 

/* 


Author ( s ) : 
Function : 


Sample program uses Trapezoidal Profile 
Position Control Mode 


#def ine MC400 
finclude "mc.h" 

void border (int, int , int, int, int); 
extern void welcome (); 


main ( ) 

{ 

int axis; 
int i; 

char input [50]; 
long final_pos; 
unsigned char max_vel; 
unsigned int acc; 
int active_axes; 
int running_f lag; 
long segment; 
long offset; 
long address; 
long voltage; 

char inchar; 
char input_bu f f [ 8 0 ] ; 
char *input_line; 
long encoder [6]; 


welcome ( ) ; 
clrscr ( ) ; 

printfC'This program resets 
printf ("trapezoidal profile 
printf ("joints . \n"); 


the controllers for 4 axes, then performs an\n" ) ; 
position control mode to move the specif ied\n" ); 


/* This address needs to be changed for new setup */ 
segment = OxAOOOL; 
offset = OxOlOOL; 


printf <"\n") ; 

printf ( 11 

printf ("I This program setups the controller 

printf ("I = %lx 

printf (" 


board at 


memory 


address 


as 


— \n") 

I \n" 
I \n", 
— \n") 


mc_init (segment , offset); 

for (axis = 0; axis < MAX_AXES; axis++) 

{ 


me reset (axis); 



mc_set_gain (axis, 250) ; 
mc_set_pole (axis, 64 ) ; 
mc_set_zero (axis, 128) ; 

mc_set_pc (axis, CONTROL) ; 
mc_clr_position (axis) ; 
mc_set_command (axis , 0 ) ; 

} 

mc_se t_gain (3,200) ; 

getch () ; 
clrscr ( ) ; 

border (1, 1, 80, 25, RED) ; 

windo w ( 2 , 2 , 4 4 , 1 3 ) ; 
border (2, 2, 44, 13, GREEN) ; 

gotoxy (2,2) ; 

cprintf ( "Command f ormats : \n" ) ; 
gotoxy (2, 3) ; 

cprintf ("*****************************************\n"); 
gotoxy (2,4); 

cprintf ("* Joint #, command (e.g. 1,200) *\n" ); 

gotoxy (2,5) ; 

cprintf ("* where command -300:300 encoder *\n" ); 

gotoxy (2,6); 

cprintf ("* pulses *\n"); 

gotoxy (2,7); 

cprintf ("* *\n"); 

gotoxy (2,8) ; 

cprintf ("* joint 0:3 999 for exiting *\n"); 

gotoxy (2, 9) ; 

cprintf ( n ******^^******** l<f ^**^*''* r **** llr ***^****'*****\n u ) ; 
cprintf ( f, \n”) ; 

window (2,13^40^24) ; 
border (2, 13,40,24, GREEN) ; 

window (41, 13,79,24) ; 
border (41,13,79,24, GREEN) ; 

window ( 4 5 , 2 , 7 9 , 13 ) ; 
border (45,2,79,13, GREEN ) ; 

axis= 0; 

while (axis !- 999) 

{ window (2,13,39,24) ; 
gotoxy (2,2) ; 

clreol ( ) ; 

cprintf ( "Enter command: ") ; 

gets (input ) ; 

if (sscanf (input , "%d, %ld", &axis, &voltage) >0 && axis < MAX_AXES && voltage 

{ 

mc_set__f inal (axis, voltage) ; 

mc _ set _ mve -*- ( ax ^ s r 100 ) ; 
mc _ set _ acce ^ ( ax ^ s ^ 10 ) f 

mc_set_f lags (axis, TRAP_SET) ; 
running_flag = 1; 

while (running_f lag || IkbhitO ) 

{ running_flag = 0; 
window (41, 13, 79, 24) ; 

for (i=0 ; i<MAX_AXES; i-r+) 

{ 


encoder [i] — mc__get__position (i) ; 

cprintf ("encoder position %d : %ld \n", i, encoder [ 1 ] ); 

} 

window (45,2,79,13); 

for ( i=0 ; i<MAX_AXES; i++) 

{ 

cprintf ("command position %d : %ld \n", i, mc_get_command ( i) ) 

if (mc_get_status (axis) & P RO F I LE_F LAG ) running_flag - 1, 

} 

} 

else 

{ 

cprintf ("%c !! ! Wrong command, enter again !!! \n", 0x007) ; 

} 


} 


void border (int startx, int starty, int endx, int endy, int color) 

{ 

register int i; 

textcolor (color) ; 
gotoxy(l,l); 

for <i=0; i<=endx-startx; i++) 
putch (OxCD) ; 

gotoxy ( 1 , endy-start y ) ; 

for (i=0; i<=endx-startx; i++) 

putch (OxCD ) ; 

for (i=2 ; i<endy-starty ; i++) 

{ gotoxy (l,i); 
putch (OxBA); 

gotoxy (endx-startx+1 , i) ; 
putch (OxBA) ; 

} 

gotoxy (1, 1) ; 
putch (0xC9 ) ; 

gotoxy (endx-startx+1, 1) ; 
putch (OxBB) ; 
gotoxy (1, endy-starty) ; 
putch (0xC8) ; 

gotoxy ( endx-startx+1 , endy-starty ) ; 
putch (OxBC) ; 

textcolor (YELLOW) ; 

} 
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Assume i i) applied statics^ at iop I 

2.) Reaction Torres sustain vertical comforts 
cm\y. 

Basic Equations*. 

v 

XFv — 0 =? ~ Vsinp — Peef^cp =o 


: IFv^O 

i 

5 2H-c 


K , — W - V ccsf> — psi n 0 = O 

h - W(pmc:^) - \/j^Sic(9o-(p- 
h?rt + ■PWsa- CaUc/,;"! =. C 
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Stnsrath Analysis wed) ’ 


Solving, (assume W=2D Its. , c< = 32.6; P= 56*.) 

\j— -^.oos^ *- @0=0°, lks - 

p = w s - m 0 | *_ @0=90°, R>»=10-0 lbs. 



STrecs ; 



! 


i ; 



/ 


ORIGINAL PAGE IS 
OF POOR QUALITY 





Acfuator power 'Rg^urreraents • 



+ 


F =* Actuator -fcrce 
^ Fri cf ion fcrce. 

V TawjentBl Vebci^ 
W =$> Load 
V\/* =* Normal Load 

Wt ^ ISHgevYioi LPcC j 


& =? Angle rc 


I o I iVu 


Assume * 


To hor'isoni© 


0 Mo fsngevrnd) acceleration ; V is constant 0 a^y | F 
2 ) Require V - 6 "Vsec | 

i 

s) Kinetic tricfioh fcrce coefficient , ^ = 0.2 j 


T/ Me- iecT ce\i i rip^i si Torce. 
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Fj = M< W„ = yMit Wsin 9 
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Actuator Bw er Requirements (continued) - 

Insert Known variables and convert units, 
power (B) = 0.0182 (cos 0 +- 0.2 sine) k 


Mo* Power Required (wlnsn 4^ =o) 

1 (Xt7 







. on 


^ue 


Require rne.ni s • 


r«« = 


UJ , Angular Veicc, 

/ vj 

^ V — - ■ 
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MOTOR MOUNT 


TOP 



All dimensions in inches 
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MANIPULATOR 

Open position 



Figure 1 


URSA - ROBOTIC ARM 
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MANIPULATOR 

Closed position 



Figure 2 


URSA - ROBOTIC ARM 


MANIPULATOR 

Intermediate position 




Figure 3 


URSA - ROBOTIC ARM 
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BASE DIMENSIONS 



Figure 5 


URSA - ROBOTIC ARM 
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GRIP DIMENSIONS 
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URSA • ROBOTIC ARM 
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LINK, PIN, AND PUSHROD 
DIMENSIONS 
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URSA • ROBOTIC ARM 



